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O-STABILIZED PLATFORMS FOR FORCE-FEEDBACK APPLICATIONS 



Reference to Related Applications 

This invention claims priority of U.S. Provisional Application Serial No. 60/005,861, filed 
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October 26, 199^, the entire contents of which are incorporated herein by reference. 
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Field of the Invention 

The present invention relates generally to force feedback and, more particularly, to the use 
of gyroscopic stabilization to provide an inertial frame against which a force-reflecting device 
react. 

Background of the Invention 

Force-feedback technology and related devices may be divided into four broad application 
areas: medical, entertainment, teleoperations, and virtual reality. Teleoperations, the research of 
which provided the foundation for the development of force-feedback devices, is the process of 
locally controlling a remote device. The primary difference between virtual reality and teleopera- 
tions is in the objects which they control. With teleoperations, actual physical robots are manipu- 
lated in the real world, whereas virtual reality involves simulated devices in synthetic worlds. 
Force-feedback for telerobotics has evolved large and bulky mechanical arms to more joystick- 
like designs. In general, these devices are designed for six degree-of-freedom (6DOF) force feed- 
back, and have the capability to provide high levels of force. More recently, finger-operated 
devices have also been introduced for use in teleoperations applications. 

The use of force feedback in medical training, simulation, and teleoperations is also increas- 
ing, with the primary application being minimally invasive surgical techniques which use lapar- 
scopic tools to perform intricate tasks when inserted into body cavities through small incisions. To 
realistically simulate laparoscopic tool forces, special-purpose force-feedback devices are cur- 
rently under development. 

The entertainment field is very difficult to address with force-feedback technology, since the 
applications demand both higher performance and lower costs. There are three primary markets 
for force feedback devices in entertainment: location-based entertainment (LBE), arcades, and 
home entertainment. LBE demands the highest performance while home entertainment demands 
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the lowest cost. Despite the conflicting demands, progress is being made in each of these fields. 

It may be argued that each of the application domains just described has its roots in virtual 
reality, which is becoming dominant in all immersive applications. As a consequence, on-going 
research in immersive applications is often termed "virtual reality," whereas, when the research is 
completed, the application is given a specific name, such as a surgical simulator. Overall, virtual 
reality is becoming increasingly popular as a preferred means of interacting with many scientific 
and engineering applications. To cite two of many examples, molecular modeling and automobile 
design are moving from standard graphics, carried out on conventional graphics terminals, to 
more interactive environments utilizing 3-D stereo graphics, head-mounted displays and force 
feedback. 

As visualization is a very important aspect of these applications, interesting and useful tech- 
nologies are being developed, including graphical object representations and large working vol- 
umes (CAVES). Concurrently, haptic interfaces are being perfected, which enable manual 
interactions with virtual environments or teleoperated remote systems. The haptic system is a 
unique sensory system in that it can both sense the environment and allow a user to react accord- 
ingly. As a result, haptic devices not only stimulate the user with realistic sensor input (forces, tac- 
tile sensations, heat, slip, etc.), but also sense the user's actions so that realistic sensory inputs can 
be generated. Haptic devices are divided into two classes, depending upon the type of sensory 
information being simulated. The first, tactile, refers to the sense of contact with the object. The 
second, kinesthetic, refers to the sense of position and motion of a user's limbs along with associ- 
ated forces. 

Broadly, these approaches point toward the same goal: to immerse a person in a seemingly 
visual reality, complete with haptic feedback. However, a major deficiency with all existing force- 
generating devices is the requirement that they be connected to a fixed frame, thus forcing immo- 
bility on the user. State-of-the-art force-feedback devices, for example, are table mounted, requir- 
ing the device to be mounted to an immobile object in order to generate a fixed point of leverage 
for forces and/or torques. Consequently, no existing force feedback device allows for easy mobil- 
ity and force generation. This problem is fundamental, since many virtual reality applications 
require large working volumes and the ability to move freely within these volumes, to provide 
realistic visual and audio feedback during walk-through scenarios, for example. 

In summary, large, immersive environments such as CAVES currently lack haptic feedback, 
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primarily because the existing technology will not support unrestricted motion. This leads to one 
conclusion that force-feedback devices must migrate as visual technologies have, that is, from the 
desktop to large-volume, immersive environments. However, the design of a hand-held, spatially 
unrestricted force-feedback device is fundamentally different from existing devices, which typi- 
cally use primarily electromechanical or pneumatic actuators operating against fixed supports to 
achieve active force feedback. Nor is the realization of such a device intuitively obvious. To con- 
struct an n-axis joystick, requiring 1, 2, 3 to n+3 motors, presents significant challenges, for 
example, since the additional motors may significantly increase the cost and/or weight of the 
device. 

Summary of the Invention 

The present invention addresses the need for force feedback in large, immersive environ- 
ments by providing a device that uses a gyro-stabilization to generate a fixed point of leverage for 
the requisite forces and/or torques. In one embodiment, one or more orthogonally oriented rotat- 
ing gyroscopes are used to provide a stable body or platform to which a force-reflecting device 
can be mounted, thereby coupling reaction forces to the user without the need for connection to a 
fixed frame. In one embodiment, a user-interactable member is physically coupled to a stabilized 
body, with the control structure used for stabilization and that used to mitigate force-feedback 
being substantially independent of one another, enabling different stabilization mechanisms as 
described herein to be used with existing force-feedback capabilities. In alternative embodiments, 
inventive apparatus and methods are used which take into account both the movements associated 
with the gyroscopic stabilization, a user's movements, and the application of torques and forces to 
realize a spatially unrestricted force-feedback device requiring fewer motors and structural ele- 
ments. Specifically, an inventive control scheme is used in these cases to accelerate and deceler- 
ate the motor(s) associated with providing the gyroscopic stabilization such that only the desired 
tactile feedback is experienced by the user. All of the various approaches are applicable to single 
and multiple degrees of freedom. 

A three-axis implementation includes a set of three, mutually perpendicular momentum 
wheels which form the gyro-stabilized platform, an attitude measuring device, and a control sys- 
tem. The attitude measuring device is employed to detect disturbances to the gyro-stabilized plat- 
form, including reaction torques due to a user's interactions with the device. The control system 
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varies the speed the momentum wheels in order to maintain the gyro-stabilized platform in a fixed 
position. In an alternative embodiment, a reaction sphere is used to produce the requisite inertial 
stabilization. Since the sphere is capable of providing controlled torques about three arbitrary, lin- 
early independent axes, it can be used in place of three reaction wheels to provide three-axis stabi- 
lization for a variety of space-based and terrestrial applications. 



N FIGURE 1 is a drawing of a one-dimensional space gyroscopic model, as seen from an 
oblique perspective; 

\FIGURE 2 is a drawing of a three-axis stabilized system model, as seen from an oblique 
perspective; 

N FIGURE 3 is a drawing used to illustrate torque generation with respect to a momentum 
sphere; 

^ FIGURE 4 is a block diagram illustrating a closed-loop control system; 

^ FIGURE 5 is a block diagram illustrating a closed-loop control system with disturbance; 

^FIGURE 6 is a block diagram depicting plant feedback with optimal feedback for linear 



^FIGURE 8 is a state diagram used to illustrate position regulation of a 1-D satellite plant 
using pole placement; 

NFIGURE 9 is a state diagram used to illustrate a final design of a 1-D satellite model con- 
troller; 

NFIGURE 10 is a skeletal representation of momentum sphere housing; 
\^ FIGURE 1 1 is a simplified drawing of an aspect of a momentum sphere depicted infrared 
emitters and detectors; 

\ FIGURE 12 is a simplified drawing showing a great circle band of reflective material 
around a momentum sphere; 

^FIGURE 13 is a drawing, seen from an oblique perspective, illustrating a different aspect of 
a momentum sphere; 

FIGURE 14 is a cross-sectional view of a momentum sphere illustrating how a control sub- 
system may interact with optical emitters and a reflective band; 



Brief Description of the Drawings 



regulations; 

^FIGURE 7 is a representation of a mathematical model of a 1-D model plant; 
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^ FIGURE 15 is a block diagram used to describe a momentum sphere control environment; 

^ FIGURE 16 is a drawing, as seen from an oblique perspective, of a spacecraft including a 
pitch momentum wheel; 

FIGURE 17 is a simplified drawing used to illustrate the stabilization of a gimbal sensor 
platform; 

^FIGURE 18 is a block diagram of a single-axis momentum wheel for terrestrial applica- 
tions; 

^FIGURE 19 is a drawing of a momentum wheel viewed from a top-down perspective, 
before the application of motor current; 

^ FIGURE 20 is a drawing of a momentum wheel after the application of motor current; 
N FIGURE 21 is a root-locus plot; 

^FIGURE 22 is a time-response plot of a one-dimensional motor application according to the 
invention; 

^FIGURE 23 is a graph used to illustrate the control effort of a 1-D motor; 

N> FIGURE 24 is a drawing, as seen from an oblique perspective, of a hand-held force-feed- 
back controller utilizing three momentum wheels to provide inertial stabilization in three space; 

^ FIGURE 25 is a drawing of a block diagram of a spatially unrestricted force feedback con- 
troller utilizing three momentum wheels to provide inertial stabilization in three space. 

Detailed Description of the Preferred Embodiments 

According to the invention, programmed amounts of rotary force are used for motion com- 
pensating and/or the stabilization of free-flying platforms, or to provide force/torque outputs from 
platforms to attached frames. Specific embodiments are disclosed with respect to spacecraft stabi- 
lization, as well as to the application of forces and/or torques to hand-held force generating 
devices, including joysticks, steering wheels, and implements of arbitrary shape for specific appli- 
cations, such as sports simulations. 

By way of introduction, reaction wheels use the inertia of one or more (typically up to three) 
rotating flywheels to generate torques. These wheels are typically accelerated using electric 
motors which can be controlled to increase or decrease rotary speed, thus changing rotational 
momentum. When the wheel on a particular axis is accelerated through increased motor torque, 
an equal and opposite reaction torque is generated and applied to the base upon which the wheel is 
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mounted. 



Reaction wheels are the most precise type of attitude control mechanism. However, when 
called upon to provide non-cyclic torques, they must be periodically unloaded by other means (i.e. 
when the motors have accelerated to maximum RPM in any direction, no additional acceleration 
can be realized in that direction unless the motors are slowed, generating torques in the opposite 
direction). Moreover, to provide arbitrary torques, three wheel axes must be provided. 

This application describes how reaction wheels as currently only applied only to spacecraft 
can be extended into several other related terrestrial applications, including gyro-stabilized bodies 
and tethered, force-generating/reflective input devices. Preliminarily, the following description 
will demonstrate and how three axes of reaction wheel can be reduced into a single, reaction 
sphere, useful either in the space-based or terrestrial applications. A description of reaction 
wheels and spheres will first be presented, followed by a discussion of the extensions to such tech- 
nology made possible by the invention. 

Single Plane of Torque Action 

The single plane model for a torquer consists of a spinning wheel attached to a frame. There 
is a reference frame, JS, embedded in the frame and a fixed reference frame, A, in the world. Refer- 
ence frame B is aligned with the axis of the spinning wheel. The system is shown in Figure 1. 

The reference frame B has two degrees of freedom with respect to reference frame A. These 
degrees of freedom are described by generalized coordinates q v q 4 , where q } represents the 

angular degree of freedom about unit vector ^ and q 4 represents the linear degree of freedom 

along unit vector a x . With this model, the unit vectors in frames A and B are related by 



The center of mass of the frame is located at the origin of the B reference frame. The frame 
is assumed to be a cube with a mass of M and height of R. 

The location of the center of mass of the wheel, d, is given by the vector , 



where / is the offset from the center of the frame (in meters) and is a run-time parameter. 
The notation \ B denotes some vector v in reference frame B with respect to reference frame A. 
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The mass of the (assuming without loss of generality a solid cylindrical disk) wheel is given by 

m - npr 2 h (3) 

where p is the density of the material of the wheel, r is the radius of the disk and h is the 

height of the wheel; and have the units of kg/m 3 , meters and meters respectively. 
The central inertia dyadic of the wheel is given by 

\ d/d = / 2 b 1 b 1 (4) 

^ where 

2 

r?c^ I 2 = r ^r- (5) 

The orientation of the wheel with respect to the frame is given by the generalized coordi- 
nates q 3 . This generalized coordinate is about the bj axis. 
The central inertia dyadic of the frame is given by 

I f/f = 7 6 b 1 b 1 (6) 
where (assuming without loss of generality that the frame is cubic) 



Since there are two rigid bodies in this model (the frame and the wheel), the angular veloci- 
ties and accelerations for both must be developed. 

The reference frame B is said to have a simple angular velocity in the reference frame A 
because there exists for all time a unit vector whose orientation in both the reference frame B and 
reference frame A is independent of time. This allows writing the angular velocity of reference 
frame B as the magnitude of its angular velocity times the fixed unit vector 

A 8 • u /ox 

CO = q x b l . (8) 
To make the equations of motion concise, a generalized velocity will be defined as 

U] = q. . (9) 



do 
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A B 

Using the definition in Equation (8), co can be rewritten as 

A B 

CO = u l b l (10) 

The wheel is said to have a simple angular velocity in the reference frame B because there 
exists for all time a unit vector whose orientation in both the wheel reference frame and reference 
frame B is independent of time. This allows writing the angular velocity of the wheel as the mag- 
nitude of its angular velocity times the fixed unit vector 

B d 

CO = q 1 b l . (11) 
The angular velocity of the wheel in reference frame A is given by 

V = ( Wj + ?7 )b r (12) 
Defining another generalized velocity, 

w 7 = ? 7 (13) 
allows expressing Equation (12) in terms of generalized velocities only as 

A (to = (Wj +w 7 )b 1 . (14) 
The angular acceleration of reference frame B is found to be 

a = u l b 1 . (15) 
and the angular acceleration of the wheel can be written as 

A d 

a = (w'j +w 7 )b 1 . (16) 



The location of reference frame B is given by 



P = 4 4 a r (17) 



A B A B 

The velocity v and acceleration a of this frame are found to be 



A B A B 

v = q^2L x a = 4 4 aj (18) 



since the unit vectors a . are fixed in reference frame A. 
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Defining a generalized velocity 



U 4 = <?4 



allows rewriting Equation (18) as 

A B 

v = M 4 a x 



a = M 4 aj 



By defining the disturbance forces acting at the origin of reference frame B as 

F =/c a l' 

the disturbance torque acting on the frame as 

T 5 = x^.and 
and the motor torque, applied to the wheel, as 

T d = ^ b i 

the equations of motion are found to be: 

x x~ ((/z + ZgK+W) = 0 
f x -(M + m)U 4 = 0 

X d~ ( 7 2 M 'l +/ 2"7) = 0 

Rewriting Equation (24) in matrix form yields 





"l 




T 

X 


_ h h 









(19) 



(20) 



(21) 



(22) 



(23) 



(24) 



(25) 



To control this system, an expression for x d that allows the system to move from any value 
of {q v «,} to any other value of {q { , Uj} in the presence of disturbance torques x x must be 
developed (see Section below). To gain a understanding of the system, first set i = 0. 
Equation (25) can now be written as 

From control theory, it is known that this equation is not stable since the poles lie on the 
imaginary axis. Thus, the form of x d required to satisfy stability criteria must meet the following 



two criteria: 

1. It must move the poles of Equation (26) into the left-half plane. 

2. It should utilize values of {q v u p q v u 7 ] to control the system as these state variables can be 
measured. 

If the disturbance torque is not set equal to zero, then Equation (26) is rewritten as 

x d + I 2 U i = % x (27) 
and a third requirement for the control torque is added: 

3. It must be robust for a specified set of disturbance torque values and functional forms. 

Some simple relationships are also developed to suggest appropriate motor parameter val- 
ues and sizes for the momentum wheels. For real world application, it is important to be able to 
specify certain aspects of the problem, such as force produced, the period of time for which it is 
produced and the mass of the device. Also, to stay firmly rooted in reality, it is important to spec- 
ify the power output of the motor. 

Equation (28) shows the basic equations 

/ = mr 2 % - la 

(28) 

CO = CLt P = XCO 

where / is the moment of inertia of the momentum wheel (assuming that it is a thin hoop; 
for a solid disk, / = mr 2 /2 and, in reality, the actual value will fall some place in between), m is 
the mass of the momentum wheel, r is the radius of the momentum wheel, x is the torque applied 
to the operator (which is the same as the torque produce by the motor), a is the angular accelera- 
tion of the momentum wheel, co is the angular velocity of the momentum wheel, t is the period of 
time for which the torque is felt and P is the power output of the motor. 

To feel a torque produced by a motor that is not attached to some fixed structure, the motor 
rotor must be accelerating. The rotor will continue to accelerate until the motor reaches its maxi- 
mum angular velocity, a value that is determined by motor parameters (but the calculation of 
which is not important for this analysis). To increase the amount of time during which the torque 
can be felt, it is necessary to slow down the angular acceleration of the motor by increasing the 
moment of inertia of the rotor. 

Equation (28) has four equations and eight parameters. Of these parameters, an equation is 
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formed that relates m, r, t, % and P because these are the parameters that can be controlled during 
the design of the device. One such form of this equation is 

r = Js- (29) 

Arbitrary Torque Generation From Wheels 

To generate arbitrary torques, a 3D platform consisting of three spinning wheels attached to 
three non-coplanar axes of a frame is required. (For simplicity, and without loss of generality, this 
work assumes that the axes are mutually perpendicular.) There is a reference frame, B, embedded 
in the frame and a fixed reference frame, A, in the world. Reference frame B is aligned with the 
axes of the three spinning wheels, thus defining a set of mutually perpendicular unit vectors. The 
system is shown in Figure 2. 

The reference frame B has six degrees of freedom with respect to reference frame A. These 
degrees of freedom are described by generalized coordinates q v q 6 , where q v # 3 repre- 
sent the angular degrees of freedom about unit vectors a 1? a 2 , a 3 respectively and q 4 , q 6 rep- 
resent the linear degrees of freedom along unit vectors & v a 2 , a 3 respectively. The orientation of 
reference frame B with respect to reference frame A is described using a Body 3: 1-2-3 representa- 
tion. Table 1 shows the relationship between the unit vectors a 1? a 2 , a 3 and b v b 2 , b 3 . 







b 2 


b 3 


a l 


C 2 C 3 


~ C 2 S 3 


s 2 


a 2 




^'^l'^2 , ^3 ^3^*1 


~ S \ C 2 


a 3 


~ c l s 2 c 3 + 


^1*^2*^3 ^3*^1 


C \ C 2 



Table 1: Direction cosines 

The terms c., s i are defined as cos and sin (q^ respectively. 
_ To simplify some expressions, the following terms are defined: 

^ lQ~Ziy^ Z 2 = 5 i 5 2 c 3 + J 3 c i Z 5 =- i y 11 y 2 5 3 + c 3 c 1 Z g = -5 1 c 2 (30) 
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Since the equations of motion will be developed using the unit vectors in reference frame B, 
the unit vectors in reference frame A are explicitly presented using the terms Z t defined in 

Equation (30). 

a A = Zjbj + Z 4 b 2 + Z 7 b 3 

a 2 = Z 2 b 1 + Z 5 b 2 + Z g b 3 (31) 
a 3 = Z 3 b 1 +Z 6 b 2 + Z 9 b 3 

For simplicity, and without loss of generality, the center of mass of the frame is located at 
the origin of the B reference frame and the frame is assumed to be cubical with a mass of M and 
height of R. 

The central inertia dyadics of the frame is given by 

^ = / 6 b l b l +/ 6 b 2 b 2 + / 6 b 3 b 3 (32) 

where 

MR 2 



The locations of the center of mass of the wheels, d„ are given by the vectors p^' , where 

V 1 = V 2 = lb 2 V 3 = *b 3 (34) 

where / is the offset from the center of the frame (in meters). The mass of each wheel 
(assuming without loss of generality that each wheel is a solid cylinder) is given by 

m = npr 2 h (35) 

where p is the density of the material of the wheel, r is the radius of the fisk and h is the 

height of the wheel and have the units of kg/m 3 , meters and meters respectively. 
The central inertia dyadics of the wheels are given by 

l /dl = / 2 b 1 b 1 + / 1 b 2 b 2 + / 1 b 3 b 3 

\ l/dl = / 1 b 1 b 1 + / 2 b 2 b 2 + / 1 b 3 b 3 (36) 
l z ' d * = /! bib! + /, b 2 b 2 + / 2 b 3 b 3 
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_ _ where 

— T m(3r 2 + h 2 ) r mr 1 

U^OK 7 i= 12 / 2 = ~2" 7 3 = / 2-V (37) 

The orientation of the wheels with respect to the frame are given by the generalized coordi- 
nates q v ...,q g . These generalized coordinates are about the b 1? b 2 , b 3 axes respectively. 

Since there are four rigid bodies in this model (the frame and the three wheels), the angular 
velocities and accelerations for all four must be developed. 

A B 

The angular velocity of the frame, co is found to be 

A (0 B = (c 2 c 3 q l + s 3 q 2 ) bj + (- c 2 s 3 q x + c 3 q 2 ) b 2 + (s 2 q x + q 3 ) b 3 . (38) 
To make the equations of motion concise, three generalized velocities will be defined as 

u l = c 2 c 3 q { + s 3 q 2 u 2 = - c 2 s 3 q { + c 3 q 2 u 3 = s 2 q x +q 3 . (39) 

A B 

Using the definition in Equation (39), co can be rewritten as 

A B 

CO = u l b 1 + u 2 b 2 + w 3 b 3 (40) 

The wheels are said to have a simple angular velocity in the reference frame B because there 
exists for all time a unit vector whose orientation in both the wheel reference frames and reference 
frame B is independent of time. This allows writing the angular velocities of the wheels as the 
magnitude of their angular velocity times the fixed unit vector 

co = q 1 b l co - = <? 8 b 2 co = q 9 b 3 . (41) 
The angular velocities of the wheels in reference frame A are given by 

A ($ x = (u x + q 7 ) bj + u 2 b 2 + w 3 b 3 

A d-, 

co = Wjbj + (u 2 + <j g ) b 2 + w 3 b 3 . (42) 

^g/ 3 = w 1 b 1 + w 2 b 2 + (w 3 + #' 9 )b 3 
Defining three more generalized velocities, 
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allows expressing Equation (42) in terms of generalized velocities only as 

A d x 



0) 1 = (wj + w ? ) bj + « 2 b 2 + w 3 b 3 



4 </ 2 

0) = WjbjH- (w 2 + w 8 )b 2 + w 3 b 3 . (44) 



co = Mjbj + « 2 b 2 + (« 3 + w 9 ) b 3 
The angular acceleration of reference frame B is found to be 



A B 

a = M 1 b 1 + w 2 b 2 + w 3 b 3 . (45) 
The angular accelerations of the wheels can be written as 

A d x 

a = (uj + w ? )b 1 + (w' 2 + w 3 w 7 )b 2 + (w' 3 -w 2 w 7 )b 3 

A d 2 

a = (w 1 -w 3 w g )b 1 + (w 2 + w 8 )b 2 H- (w 3 + M 1 w 8 )b 3 . (46) 

A d 3 

a = (u l +w 2 w 9 )b 1 + (u 2 -u l u g )b 2 + (i/ 3 + w 9 )b 3 
The following terms are defined to simplify the equations 



Z 10 


= u ] 


+ w' 7 


z i3 


= W* 2 + W 3 M 7 


Z ,6 


- l/ 3 


- M 2 « 7 




z n 


= u l 


- M 3 M 8 


Z 14 


= w 2 + || g 


Z 17 


= w" 3 




(47) 


Z 12 


= w, 


+ u 2 u 9 


Z 15 


= w 2 - Wj w 9 


7 


= w 3 


+ u 9 





thus allowing Equation (46) to be rewritten as 



A d x 

a 


= z io b i 


+ Z 13 b 2 


+ Z 16 b 3 


A d 2 

a 


= Z n b l 


+ Z 14 b 2 


+ Z 17 b 3 


A ^3 

a 


= Z l2 b 1 


+ z 15 b 2 


+ Z lg b 3 



(48) 



There are four points of interest in this problem: the location of reference frame B and the 
locations of the centers of mass for each of the wheels. The location of reference frame B is given 
by 

V = <7 4 a l + 4 5 a 2 + 46 a 3- (49) 




and its velocity \ B and acceleration A & B are found to be 

V = + q 5 * 2 + q 6 a 3 V = + q^ 2 + q^ (50) 

since the unit vectors a f are fixed in reference frame A. 
Defining generalized velocities 

w 4 = *4 W 5 = 4 S u 6 = *6 ( 51 ) 

allows rewriting Equation (50) as 

a B a B 

v = w 4 a x + w 5 a 2 + w 6 a 3 a = + w* 5 a 2 + w 6 a 3 (52) 

The velocities of the centers of masses of the wheels are found to be 

A d x A B A B 

v = v + co x/bj = w 4 aj + w 5 a 2 + M 6 a 3 + /« 3 b 2 -/w 2 b 3 

A rf 2 A B A B _ 

v = v + co x/b 2 = M 4 a 1 + M 5 a 2 + M 6 a 3 -/w 3 b 1 + /w 1 b 3; (53) 

A d^ A B A B , . 

v = v + co x/b 3 = w 4 a 1 + w 5 a 2 + w 6 a 3 + /« 2 b 1 -/w 1 b 2 
and the accelerations of the centers of masses of the wheels are found to be 

A d 

a 1 = w 4 a! + w 5 a 2 + w 6 a 3 -/(w| + w 2)k i + ^^ 

A d 

a 2 = ^aj + w^ + w^ + Z^^-^ (54) 

A d 3 

a = w 4 a x + w 5 a 2 + w 6 a 3 + / (u^ + w 2 ) b x + / (w 2 w 3 - Wj) b 2 - / (k* + M 2j ^ 

There are three sets of forces acting on this system: the applied disturbance forces and 
torques applied to reference frame B that represent, the gravity forces acting on the wheel and 
frame masses and the motor torques applied to the wheels. 

The disturbance forces acting at the origin of reference frame B is defined as 

F = / c a 1 +/ y a 2 +/ z a 3 (55) 
the gravity force on the frame is defined as 

G f = -Mga 3 (56) 

or equivalently as 

G f = -Mg (Z 2 b l + Z 6 b 2 + Z 9 b 3 ) ; (57) 
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and the three gravity forces, which act at the center of the wheels, are defined as 

G d] = -mga 3 G dj = -mga 3 G dj = -mga 3 (58) 
or equivalently as 

G dj = -mg(Z 3 b 1 + Z 6 b 2 + Z 9 b 3 ) 

G d 2 = ~ m S ( z 3 b i + Z 6 b 2 + Z 9 b 3 ) (59) 

G d 3 = ~ m 8 ( Z 3 b l + Z 6 b 2 + Z 9 b 3) 

The disturbance torque acting on the frame is defined as 

T 5 = Vl + V2 + X z a 3 (60) 

and the three motor torques are defined as 

\=\ h l T d 2 = ^2 T d, = V>3 (61) 

with the positive sense of the torque being applied to the wheel. However, Newton's second 
law demands that there be an equal and opposite torque applied to the frame, body B. Thus, the 
resultant moment acting on body B is given by 

T = Vl + S a 2 + V*3 - X d , b l " \ h 2 ~ V>3 • (62) 

The definitions of the generalized inertia forces was facilitated by defining The following 

terms: 

Z, 9 = /(m 2 + w 2 ) 2 22 = /(t/jMj + Mg) Z 25 = /(M,M 3 -i< 2 ) 

yi^O^ 220 = /(M 1 M 2""3) Z 23 = '(" 2 + " 3 2 ) Z 26 = '(" 2 " 3 + "'l) , (63) 

Z 21 = l(u x u 2 + ii 2 ) Z 24 = l{u 2 u z -u x ) Z 27 = /(w 2 + u 2 ) 
The equations of motion are found to be: 

x x Z x + x y Z 2 + x.Z 3 + mgl (Z 6 - Z 9 ) - [ (2/, +I 2 + 1 J u, + + 1 2 (u 2 u g - u 3 uj ] + 
ml[(Z 4 - Z ? ) « 4 + (Z 5 - Z g ) u s + (Z 6 - Z 9 ) U 6 - 2/w, ] = 0 

T * Z 4 + + T ^ Z 6 + m S l ( Z 9 - Z 3 ) " [ ( 2/ l +I 2+ 7 6 ) "2 + 7 2"8 + h ( M 3 " 7 ~ "l « 9 ) 1 + 

m/ [ (Z 7 - Z, ) « 4 + (Z g - Z 2 ) m 5 + (Z 9 - Z 3 ) m 6 - 21U 2 ] = 0 
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X x Z i + + X z Z 9 + ( Z 3 " Z 6 ) " t (2/, + / 2 + / 6 ) « 3 + / 2 m 9 + 7 2 (a, Mg - t^) ] + (64) 
ml [ (Zj - Z 4 ) « 4 + (Z 2 - Z 5 ) m 5 + (Z 3 - Z 6 ) « 6 - 2/w 3 ] = 0 

/ x -m(3ii 4 + (-Z 19 + Z 20 + Z 21 )Z, + (Z 22 -Z 23 + Z 24 )Z 4 + (Z 25 + Z 26 -Z 27 )Z 7 ) -Mu 4 = 0 

/ y -«(3« 5 + (-Z 19 +Z 20 + Z 21 )Z 2 + (Z 22 -Z 23 + Z 24 )Z 5 + (Z 25 +Z 26 -Z 27 )Z g ) -M M - 5 = 0 

f z -m(3g + 3u 6 + (-Z 19 +Z 20 + Z 21 )Z 3 + (Z 22 -Z 23 +Z 24 )Z 6 + (Z 25 + Z 26 - Z 27 ) Z 9 ) - Mw' 6 = 0 

\- 7 2 Z io = 0 
^ 2 - 7 2 Z i4 = 0 
^ 3 - 7 2 Z i8 = 0 

Since there are nine generalized coordinates, there are 18 equations of motion, nine kine- 
matics and nine dynamic. To solve these equations numerically, they must be written in the form 

y = /(y) (65) 
where the state vector y has the form y = {$,,...; q n , w, u n ). This necessitates rewrit- 
ing Equation (39) to solve for the q. in terms of the u. . The nine kinematic equations of motion 
can now be written as 

q\ = (u lC3 -u 2 s 3 )/c 2 q 2 = u lS3 + u 2 c 3 q 3 = (- U{ c 3 + u 2 s 3 ) /c 2 + u 3 

q 4 = « 4 q 5 = u 5 q 6 = u 6 . (66) 

q 7 = u 7 q g = u s q 9 = « 9 

To write the dynamical equations of motion in the same manner, Equation (64) must be 
solved for the u. . Since several of the Z i include u ( , these terms will need to be expanded. As a 
first step, the following terms are defined 

Z 2g = u x u 2 Z 29 = u x u 3 Z 3Q = u 2 u 3 (67) 
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K { = I 2 (u 2 u g -u 3 u s ) -mlg(Z 6 -Z 9 ) -^ x Zi-x y Z 2 -T z Z 2 
K 2 = I 2 {u 3 u n - u, « 9 ) - mlg (Z 9 - Z 3 ) - x x Z 4 - x y Z 5 - x z Z 6 
K 3 = I 2 («j u s - u 2 u 7 ) - mlg (Z 3 - Z 6 ) - x x Z n - x y Z % - x z Z 9 



(68) 



K A = m((l(Z 28 + Z 29 ) -Z l9 )Z l+ (l(Z 2S+ Z 30 ) -Z 23 )Z 4+ d(Z 29 + Z 3Q ) -ZJZJ -f x 
K 5 = m((/(Z 28 + Z 29 ) -Z 19 )Z 2+ (/(Z 2g+ Z 30 ) -Z 23 )Z 5+ (/(Z 29 + Z 30 ) -Z 27 )Z g ) -/ y 
* 6 = m(3g + (l(Z 2g + Z 29 ) -Z l9 )Z 3+ (l(Z 2g + Z 30 ) -Z 23 )Z 6+ (l(Z 29 + Z 3Q ) -Z 21 )Z q ) -f 



K i = "V K* = -*a K a = -t. 



Next, Equation (64) is rewritten in the form Ail. = K. , thus providing a means for solving 
for the ii. . K ; is given in Equation (68) and A is defined as 



A = 



■(/ 4 + 2m/ 2 ) 



0 



0 m/(Z 4 -Z 7 ) m/(Z 5 -Z 8 ) m/(Z 6 -Z 9 ) 0 0 

0 -(/ 4 + 2m/2) 0 m/(Z 7 -Z,) m/(Z g -Z 2 ) m/(Z 9 -Z 3 ) 0 -/ 2 0 

0 0 -(/ 4 + 2«/2) m / (Zl -Z 4 ) m/(Z 2 -Z 5 ) m/(Z 3 -Z 6 ) 0 0-/ 2 

m/(Z 4 -Z 7 ) m/(Z 7 -Z,) m/(Z,-Z 4 ) -(3m+M) 0 0 0 0 0 

m/(Z 5 -Z 8 ) m/(Z 8 -Z 2 ) m/(Z 2 -Z 5 ) 
m/(Z 6 -Z,) m/(Z 9 -Z 3 ) m/(Z 3 -Z 6 ) 



"'2 

0 

0 



0 
0 



0 _(3m + M) 0 0 0 0 

0 0 -(3m + M) 0 0 0 

0 0 0 

0 0 0 

0 0 0 0 0 -/, 



-/ 2 0 0 
0 -/ 2 0 



(69) 



where I, - 21, +L+L. 



'4 - T1 2 TI 6' 

A discussion of the control system is presented in below. To simplify the equations of 
motion to facilitate control development, those terms and equations that deal with the linear posi- 
tion/force are eliminated because a gyro-stabilized platform can only counteract torques, not 
forces. Rewriting Equation (69) as indicated yields 
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-(7 4 + 2m/^) 


0 
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This equation can also be rewritten to explicitly express U. 
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(70) 



(71) 



where 7 5 = (7. + 2m/ 2 ) -7,. 



Arbitrary Torque Generation From a Sphere 

The equations of motion for the sphere, see Figure 3, can be derived from those for the three 
wheel device by noting these two salient differences between the systems: the inertia of the sphere 
is equal in all directions and is unchanged with orientations; and the center of mass of the sphere 
is located at the origin of reference frame B. The equations of motion for the sphere are given by: 
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^ x Z l +r y Z 2 + T z Z 3 -[U l+ I 6 )U l +I l U 1 + I l (u 2 u 9 -u 3 u s )) = 0 
T x Z 4 + x y Z 5 + x z Z 6-[(/ I +/ 6 ) M2 + / lM8 + / 1 ( M3M7 - MlM9 )] = o 

T JC Z 7 + T > . Z 8 + X Z Z 9-[( / l +/ 6)"3 +/ l M 9 + / l("l"8-"2 M 7)] =° (72) 

f x - (m + M)u 4 = 0 

f y - (m+M)ii 5 = 0 

/ z - (m + M)3u 6 -mg = 0 

V- 7 2 Z n = 0 
^-^14 = 0 
^3 _/ 2 Z i8 = 0 

Because the cross-coupling through the linear velocity terms does not exist for this device, 
controlling a system that employs this device for stabilization is easier than controlling a system 
that employs three reactions wheels for stabilization. 

Control Issues 

Control theory is defined as a division of engineering mathematics that attempts, through 
modeling, to analyze and to command a system in a desired manner. Of particular interest are 
closed-loop systems. In a closed-loop system, the forcing signals of the system (calling inputs) are 
determined (at least partially) by the responses (or outputs) of the system. In this manner, the 
inputs and outputs are interrelated. In Figure 4, a generic closed-loop control system is shown. In 
order to explain the contents of this diagram, the following example is used: 

The objective is to control the temperature of a room. In this case, the sensor is the 
thermostat. The system input is set by selecting a temperature. Through either some 
mechanical or electrical means, the difference between the desired and actual tem- 
perature is calculated, resulting in an error. If the actual temperature is below the 
desired, the compensator sends out a control signal to the furnace (or plant). If the 
control signal says heat on (actually, the electromechanical equivalent), the furnace 
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outputs heat. This process continues until the compensator determines it is not nec- 
essary to heat the room, and the control signal is changed to a heat off signal. 
Control theory can be classified in two categories: classical and modern. Classical control 
theory is generally a trial-and-error system in which various type of analyses are used iteratively 
to force a electromechanical system to behave in an acceptable manner. In classical control 
design, the performance of a system is measured by such elements as settling time, overshoot and 
bandwidth. However, for highly complex, multi-input/multi-output (MDVIO) systems entirely dif- 
ferent methods of control system design should be implemented to meet the demands of modern 
technology. Modern control has seen wide-spread usage within the last fifteen years or so. 
Advancements in technology, such as faster computers, cheaper and more reliable sensors and the 
integration of control considerations in product design, have made it possible to extend the practi- 
cal applications of automatic control to systems that were impossible to deal with in the past using 
classical approaches. Modern control theories are capable of dealing with issues such as perfor- 
mance and robustness. The spatially-unrestricted force-feedback system makes use of two modern 
control design methods: disturbance rejection and optimal control. 

In the design of electromechanical systems, one can consider that the system will be 
exposed to disturbances. A disturbance may be defined as any unwanted input. In Figure 5, the 
disturbance, w(t), is shown as a second input to the plant. The effect of the disturbance is added to 
the output of the plant. 

Disturbance rejection design can be used to create a compensator which is able to ignore the 
disturbance and cause the desired plant output. In this section, the basic method of disturbance 
rejection design is presented using a MDVIO model. For this model, notation must be established 
to designate the various elements of the control design; let: 

[A, B, C, D] be a state-space representation of the plant (with state x), assuming (A,B) is 
completely controllable, 
r n 

x{t) e 9* bethep/anr state. 

r n. 

u{t) 6 <K be the plant input (where n. is the number of inputs and n Q is the number of 
outputs), 

I w (t) e be the disturbance input 
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I fl 

■^.j r (0 e 9t " be the desired or reference input 



r n, 



-g\ y (t) e SR " be the smsor output 



e (f) e SR " be the tracking error 
The lumped MIMO linear, time-invariant (LTI) system, may be expressed as: 

x = Ajc + Bu + Ew (73) 
y = Cx + Du + Fw (74) 



e = r-y 

The model for the input (Equations (76)-(77)) and the noise (Equations (78)-(79)) are: 



(75) 



x r = A r x r (76) 
r = C r x r (77) 
x - A x (78) 

*w - A W X W ' 

w = C x (79) 

The objectives in the design of the feedback system in Figure 5 are as follows: 

• Closed-loop system must be exponentially stable, 

• Achieve asymptotic tracking and disturbance rejection for all initial states 

• Robustness 



^ If this is true, then for all initial states of the system, « (r) -> 0 e 9^" as f -» ~ . 

Given the system [A,B,C,D], suppose it is minimal. Let the compensator be given by 



= Ax + Be (80) 



where 



^\ a c = diagtrv^, .... e a"'*"' (81) 

^\ B c = diagty,, Y 2 » • -Yj eV'"" (82) 
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with 



5l 



r = 

i 



o 
o 



-oc -a , 

q q-l 



-T>4cX 



T/ = 



1 

-a, 



■i 



9? 



9x9 



(83) 



(84) 



Since \ w and A f are known, [83] can be derived from the equation 

<D(A W ;A P ) = s q + a/ _1 + ...+a q _ l s + a l 
which is the least-common multiple of the characteristic equations of A w and A r . 
Under these conditions, if 



(85) 



rank 



AJ-A B 
-C D 



= n + n 0 , VXe [a(A w ) ua(A r )] 



(86) 



~~ (which guarantees that the system is still completely controllable with the addition of the 
compensator) then 

• The composite system is completely controllable 

• Asymptotic tracking and disturbance rejection holds 

• Asymptotic tracking and disturbance rejection are robust 

The discussion contained here is establishes a mathematical basis for the invention. Control 
of a gyro-stabilized force feedback device is based on its ability to respond robustly to a control 
signal and to respond correctly despite system noise. For the single-input/single-output (SISO) 
case, this theorem reduces to the classical control case where an integrator is required for robust 
performance. This result is used in the design of the ID experiment which is similar to the classi- 
cal satellite control problem. 

Optimal control theory can be used to design compensators which are able to take into 
account the cost of performing a particular action. A classical example of optimal control is the 
use of fuel to maneuver a satellite in orbit above the earth. Two extreme scenarios are possible: 
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movement taking minimum time or movement taking minimum fuel. In the following section, dis- 
cussion will focus on the fundamental principles of optimal-control design. 

The optimal control problem is to find a control u* (t) which causes the system 

x (t) = a [x (t) , u (0 , t] to follow a desired trajectory x* that minimizes the performance mea- 
sure 

^ ts 

f>££>X /(u) = h[x(t f ) 9 t f ]+] g[x(t) y u(t),t)dt (87) 

Other names for J include cost function, penalty function, and performance index. Assume 
that the admissible state and control regions are not bounded. (This removes all mechanical con- 
straints; these can be included in later development) Let the initial states, x(t Q ) = x Q , of the sys- 
tem and initial time, t Q , be known. Also, let x e 9t" and u € 9? m . The goal now is to establish the 

necessary conditions for optimality: 

Assuming that h is differentiate and that initial conditions are fixed and do not affect mini- 
mization, [87] can be expressed as 

'/ 

T^$"lK J(u) = J{s[ x O,u(0,r] +j t [h(x(t),t)]}dt (88) 

For generality, apply the chain rule and include differential equation constraints to form an 
augmented cost function: 

J fl (u) = J {g[x(0,u(f),r] +|_^(x(0,0j *(0 + 
<-0- , (89) 

j t (x(t),t) +p (0 [a(x(0,u(O),0 - *(t)]}dt 

using Lagrange multipliers /?, (r) p n (t) . To simplify the notation, rewrite [] as fol- 
lows: 

'/ 

"T^3X j a ( U ) = j {g a (x (0 , u (0 , p (0 , 0 } dt (90) 
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The necessary conditions for optimal control can be derived using calculus of variations. 
Specifically, take the variations of the functional J a (u) by 8x, 5x, 5w, dp and 8iy. (Increment of 
the functional J is defined as: A7(x, 8x) = 87 (x, fix) + g (x, 8x) • ||8x|| ; 8J is linear with 
respect to 8x ; 8x is called the variation of the function x .) From this, the necessary conditions 
may be derived: 

~» 9 r 

5 0 x* (f) = ^<^(x* (t),u* (f) , p* (0 , 0 (91) 

■^yj^y -z'x p*(o = -^W*(o,u*(o,p*(o,o) (92) 

^2- 0 = .^<^(x*(0,u*(0,P*(0,0 (93) 

for all f e [r Qj iy] , and 



where 



(94) 



^ « (x (r) , u (0 , p (f) , r) = g (x (0 , u (t) , p (r) , t) + p [a (x (f) , u (f) , p (0 , 0 ] (95) 
The principles of calculus of variations are applied to the design of a linear regulator. The 
linear regulator is used in the control of the motors used to spin the inertial masses to change the 
attitude of the satellite system. The regulator design is particularly useful in controlling unstable 
systems through optimal pole placement. First, recall the state equation of a linear, time-varying 
plant: 

x(0 = A(f)x(r) +B(f)u(f) (96) 
The cost function to be used is 



^yp^r J = 5x r ('/) Hx ('/) +|J [x r (0Q(0x(0 +u r (f)R(f)u(f)]A 



(97) 



where t f is fixed, H and Q are real, positive-semi-definite matrices, and R is a real, positive- 
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definite matrix. The purpose of the regulator is to maintain the state of the system as close to a 
desired set of parameters as possible without excessive control effort. The necessary conditions 
for optimality to be used are: 



x (f) = A(r)x*(0 +B(f)u*(f) 
P*(0 = -Q{t)x*(t) -A r (f)p*(0 

0 = R(0u*(0 +B r (f)p*(0 

where the Hamiltonian is defined as 

r K(x(/),u(0,p(0,0 = \x{t)Q(t)x(t) +\u T (t)R(t)u(t) + ... 

p (t)\(t)x(t) +p (OB(f)u(f) 
Equation (100) is easily solved for the optimal input for the regulator, yielding 

u*(0 = -R" 1 (0B r (0p*(0 



(98) 
(99) 
(100) 



(101) 



(102) 



It is now possible to form an augmented, closed-loop state-space equation of the regulated 
system: 



>?!?< 



x*(0 









A(0 -B(0R"'(f)B T (f) 



.-Q(0 



T 

-A 7 (0 



x*(f) 

Ip*(0J 



(103) 



These In differential equations have a solution of the form: 



X* (t f ) 

_p*(^)j 



= <p(»>0 



x*(f) 

lp* (0J 



(104) 



— d 

Note: cp (fy> 0 is called the transition matrix, define by ^jcp (t^t) = A (f) (p (^ f) with the 

initial condition of (p ( t Q , t Q ) = I and is solved through numerical integration. By partitioning the 

state transition matrix, (p (^ t) , the following solution for p* (f) can be reached: 

p*(0 = K(r)x*(f) . (105) 
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Therefore, the optimal control law is 

u*(0 = -R" l (f)B r (0K(f)x*(0 =F(f)(x*(0); (106) 
the next step is to define a method of solving for K. This is achieved using a Riccati-type 
differential equation: 

K(f) = - K(f)A(0 -A r (f)K(f) -Q(f) +K(0B(0R" 1 (0B 7 (f)K(f) (107) 
which involves solving n (n + 1) /2 first-order differential equations. Fortunately, the motor 
system involved in the hand controller control system can be considered time invariant. This sim- 
plifies the previous equations, which can be summarized as: 

x(0 = Ax(f) +Bu(f) (108) 

oo 

"TOSO>C J = J[x r (0Qx(0 +u r (f)Ru(01* (109) 
o 

K = - KA - A 7 K - Q + KBR _1 B 7 K = 0 (110) 
and the optimal control law is 

u*(f) = -R~ l B T Kx*(t) = Fx*(f) . (Ill) 
As long as Q is positive definite, the closed-loop system is guaranteed to be stable and the 
controller may be used for pole placement design of the system, as shown in Figure 6. 

The design of the controller system for the ID model is now presented. The first segment of 
the design is a optimal pole-placement. This is needed because a the ID model of the spatially 
unrestricted force feedback device (which is a simplified version of the actual 3D version), which 
can be considered a second-order system, is inherently unstable. Definitions of "stable" vary; 
here, "stable" is considered any plant which has only poles and zeros to the left of the imagery 
axis in the complex plane (i.e., left-hand poles and zeros). Using previously established results, 
the poles of the system are placed optimally based on the inertia of a second-order linear model. 
Lastly, disturbance rejection is augmented to the control system for robustness. 
The plant for a single DOF hand controller, Figure 7, has the form 

-^rv)c XJ t7 = a(t) (ll2) 
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where a(t) is the angular acceleration, 1$ is the inertial mass, and x (t) is the torque. 
Since the stability of this system is (at best) marginal, a pole placement is performed. Fur- 
ther, optimal methods are employed for placing these poles at the best locations. The new plant 

will follow the model in Figure 8. The optimal design will give the "best" values to use for Kj and 
K 2 . 

The first step is to choose the cost function to minimize, set initial conditions, and select the 
necessary conditions and boundary conditions which apply to this problem. Let the initial states of 

the satellite be zero: x (0) = 0 ; x (0) = 0 . The cost function for minimal control effort is 



1 f 2 
J = oJ ["(01 



dt 



(113) 



such that the amount of acceleration of the system, whether it is positive or negative, for all 
time is minimal. This is frequently used for satellites because the amount of acceleration is the 
magnitude of the control input, or for satellite, the amount of fuel, which is a limited resource. For 
this system, the following parameters are known: 



A = 



with a state defined by 



r 

and choose Q = 



0 q 2 



andR = 1. 



B = 



0 1 
0 0 

0 

J_ 



(114) 



(115) 



X 






X 




*2 



(116) 



J 



For the LTI Ricatti equation, [1 10], K has four solutions, but the only positive-definite solu- 
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tion is 



K = 



(117) 



which results in a regulator, F, of the following form: 



F = 



(118) 



fa 6 Jq l +q 2 [ K 2 



The two terms of the F vector are the position feedback and velocity feedback required for 

optimal tracking, as in Figure 8. 

The final step is to include an integrator which provides the SISO case with robustness. The 

final controller design is shown in Figure 9. 

There are some control issues that are specific to the momentum wheel concept. These 
issues are those that deal with determining the state of the sphere, which must be known to calcu- 
late the sphere's angular momentum vector. Since the nature of a spherical object allows it to be at 
any orientation relative to it's cavity, a method that can detect the sphere's exact orientation rela- 
tive to the three fixed orthogonal axis of the sphere housing is used. This is illustrated in 

Figure 10. 

Each of the three sphere housing axis is outfitted with a band of optical infra-red emitters to 
detect the relative position of the sphere. Each emitter will be placed between two (or more) infra- 
red detectors as shown in Figure 11. This technique will enable fine position sensing and simulta- 
neously minimize power requirements since a single emitter will service two (or more) detectors. 

The sphere is equipped with a single great circle band of reflective material as illustrated in 
Figure 12. As shown in Figure 13, each sensor band on the sphere housing covers one half of the 
great circle band on each sphere housing axis. Consequently the reflective band is always within 
range of at least three optical emitter/detector pairs regardless of sphere orientation. 

The IR emitter/detector sensors are located directly on the cavity face to simplify construc- 
tion of the sphere housing. Each emitter and detector is directly interfaced to the housing cavity by 
a fiber optic cable that ends at a lens mounted on the cavity face as shown in Figure 14. Using a 
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lens permits the use of lower power infra-red emitters. 

As shown in Figure 15, the infra-red emitters are driven by an output bit from the Sphere 
Control Computer. Address decode logic and latch bits contained in the Sphere Control Sub- 
system decode emitter data from the control computer and turn the appropriate IR emitter on. The 
control computer reads the associated IR receiver, via the same decode multiplexor logic in the 
Sphere Control Subsystem. 

Conventional Applications to Spacecraft 

There are two inter-related branches of mechanics that are used to spacecraft control: celes- 
tial mechanics and attitude mechanics. The former deals with the position and velocity of the cen- 
ter of mass of the spacecraft as it travels through space, whereas the latter deals with the motion of 

the spacecraft about its center of mass, see Figure 16. 

Attitude mechanics is divided into three components: determination, prediction and control. 
Attitude determination is the process of computing the current orientation of the spacecraft with 
respect to some specified inertial frame. Attitude prediction is the process of computing the future 
attitude of the spacecraft based on its current state and motion. Attitude control is the process of 
applying torques to the spacecraft to reorient it into some desired future state. The devices men- 
tioned in this patent deal primarily with the control aspect of attitude mechanics. 

For most modern spacecraft applications, three-axis control is required. This method of 
control allows mission planners to specify the orientation of the spacecraft at all times during the 
course of a mission. Missions that employ this type of control include all communications satel- 
lites, the space shuttle and earth-orbiting scientific satellites. 

To function properly, three axis stabilized spacecraft employ sensing devices that identify 
the spacecraft's attitude by determining two mutually perpendicular orientation vectors. Some 
typical examples include two-axis sun sensors and magnetic field sensors. Once the spacecraft's 
attitude is determined, the mission profile determines the control requirements. Certain scientific 
satellites require extremely precise attitude control (arc-seconds) for the purpose* of data collec- 
tion. Others, such as C-band television satellite, require less precise control (arc-minutes). Since 
all satellites are subject to disturbances, some method of maintaining proper orientation is 
required. 

There are three primary means for controlling a satellites attitude: gas jets, electromagnets 
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and reaction wheels. Reaction jets operate by expelling gas through an orifice to impart a moment 
on the spacecraft. These devices can produce large (but imprecise) torques, but since they expend 
fuel, there on-station operating time is limited. Electromagnets operate by creating magnet fields 
that interact with the magnetic field of a nearby body to produce a torque on the satellite. 
Although these systems do not expend fuel, they only function near bodies with large magnetic 
fields. Reaction wheels operate by way of Newton's third law by accelerating a wheel to absorb 
torque that is applied to the satellite. If the applied disturbances are cyclic, these systems can oper- 
ate indefinitely since there is not net gain/loss of energy. For real-world systems, reaction wheels 
typically operate in conjunction with gas jets, which are used to bleed off excess momentum as 
the wheels approach their operating condition boundaries. Reaction wheels provide a very fine 
degree of attitude control. 

Applications for Platform Stabilization 

What differentiates space-based applications from other applications is not the lack of grav- 
ity but rather the fact that gravity is the same in all directions. Similar situations can occur on the 
Earth: system with neutral buoyancy in a liquid and systems that are fixed in the direction of grav- 
ity operate under similar principals as space-based systems, see Figure 17. 

For example, consider the case where a sensor platform is to collect data from a lake over a 
period of time. If this platform is required to maintain a particular attitude, a gyroscopic system 
can be used for stabilization. Similarly, a sensor platform mounted on a research balloon may be 
required to maintain two-axis attitude control for the duration of the mission. Again, a gyroscopic 
system can be used to stabilize the two rotational degrees of freedom of this system. 



Two sets of experiments were carried out with the single degree of freedom device. The first 
experiment was intended to validate Equation (1 19). A second experiment was intended to dem- 
onstrate a control system for a three DOF system. 

To carry out these tests, a test stand was developed, as shown in Figure 18. 

This test setup consists of the following components: 

• A turntable with an attached motor. The position of the turntable is instrumented with an 
incremental encoder attached directly to the turntable (not used in this experiment). The 
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position of the motor shaft was not instrumented, however, its angular velocity is instru- 
mented. The motor employed is a Hathaway model 1500, attached to the turntable by means 
of an adapter block. 

• A momentum wheel attached to the motor shaft. This momentum wheel is manufactured 
from a piece of stock, 2 inch diameter, cast iron shaft. 

• The motor is attached to a Cyberlmpact® Intelligent Motor Controller (IMC) system, a 
standard Cybernet product and is used with all of our force feedback devices, which pro- 
vides an interface to a PC based controller that allows for a wide range of motion commands 
to be programmed. 

• The IMC is attached to a PC. In this example, a simple, previously developed interface to 
start and stop the motor was employed. This interface presents the user with an input screen 
for directly controlling the motor current. By setting the current to its maximum allowable 
value, the maximum obtainable torque is observed. By setting the current to zero, the motor 
comes to a stop. 

• A torque measuring system consisting of a spring and a camera. Applied torque was mea- 
sured by the displacement of a known spring and the time for this to happen by counting 
video frames. 

The position, velocity, and/or acceleration provided on a user-interactable member is sensed 
and transmitted as a command to a computer model or simulation which implements a virtual 
reality force field. In turn, the force field value for the given position, velocity, and/or acceleration 
is sent back to the member, which generates a force command, thereby providing the user with 
direct kinesthetic feedback from the virtual environment traversed. Although applicable to con- 
trolling a virtual or simulated environment, the technology is also well suited to the control of a 
remote or physical device. Further, the present invention is suited for application to any number 
of axes. 

The operation of the IMC system and PC interface will be best understood by referring to 
commonly assigned U.S. Patent Nos. 5,389,865 and 5,459,382, and pending applications Serial 
Nos. 08/513,488 and 08/543,606, the contents of each of which are incorporated herein in their 
entirety by reference. These patents and co-pending applications describe systems and methods 
for presenting forces to an operator of a remote device or to a user interacting with a virtual envi- 
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ronment in multiple axes simultaneously mediated through a computer controlled interface sys- 
tem which provides a position, velocity, and/or acceleration (to be referred to generally as "force") 
to a user interface which, in turn, generates an electrical signal for each of a plurality of degrees of 
freedom. These electrical signals are fed to a virtual reality force field generator which calculates 
force field values for a selected force field. These force field values are fed to the force signal 
generator which generates a force signal for each of the plurality of degrees of freedom of the user 
as a function of the generated force field. These motion commands are fed back to actuators of 
the user interface which provide force to the user interface and, thus, to the user in contact with 
the interface device. 

Before discussing these applications in further detail, a background will be provided with 
respect to inertial stabilization as its relates to reaction wheels and space-based applications, as 
certain principles of spacecraft platform stabilization have, for the first time according to this 
invention, been applied to spatially unrestricted terrestrial control. 

Experimental Data for ID Device Implementation 

Since a known momentum wheel was used, the form of Equation (29) is not quite right for 
this experiment. Instead, this equation is rewritten as 

T?4oX r = ^ (119) 

where the factor of two is used because a solid disk, not a thin hoop, was used. The mass of 
the momentum wheel is 0.277 kg (measured) and the inertia of the motor rotor is ignored. 

Using the motor electrical parameters and the electrical characteristics of the IMC chassis, 
the maximum torque that can be applied by the motor is known to be 0. 18 Nm. Inserting these val- 
ues into Equation (1 19) yields a time of 0.09 seconds. 

To measure the torque, a spring with a spring constant 1 10 N/m was attached to the adaptor 
block by way of a bolt, at a distance of 0.050 m from the center of rotation. Since F = kx and 
x = Fd, these terms can be related in the following manner 

t yrf ' - h- (120) 

Of course, the equations used are very primitive and do not account for many of the real- 
world affects. The affects, which are primarily frictive in nature, should tend to make the displace- 
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ment less than predicted and the time greater than predicted. The results of these experiments are 
shown in Figure 19 and Figure 20. The picture on the left shows the system just before current is 
applied to the motor. The picture on the right shows the system at maximum spring extension, 
which occurred five video frames, at 30 frames per second, later. The results show a displacement 
of 1.2 inches (0.030 m) and a time of 0.16 seconds. Given the experimental setup, these results are 
well within the range of experimental error, thus giving credence to the model. 

Experiments were also performed to control the position of the turntable, in the face of dis- 
turbances, by controlling the speed of the momentum wheel. The equations and methods used to 
develop this control scheme were discussed previously. For this experiment, the same setup was 
used as for the previous experiment with several small modifications: 

• The instrumented readings from the turntable and the motor shaft were used by the control- 



• The spring was removed from the experimental setup. 

• A control program was written that interfaces directly with the IMC system. 

Using MATLAB, which is a PC based mathematical tool designed to aid engineers in the 
development of complex mathematical systems, the controller and plant were simulated. Since the 
amount of control input is not a particular concern, optimal control parameters were selected to 
produce a system that responds quickly. In the following experiments, the values q { = q 2 = 10 

and R = 1 were selected. To select an appropriate value for the disturbance rejection gain, a root 
locus plot of the system, Figure 21, was developed. From this diagram, the gain of the system, 
which is selected to produce fast response time, has value of approximately 1.33x1 0" 5 . The 
response of the system of a unit step disturbance is shown in Figure 22 (plot generated from Mat- 
Lab). These parameters were then used in testing a real model of the system. 

The control parameters determined using the optimal control techniques and the root-locus 
method were applied to the system shown in Figure 18 (without the spring). Since the control 
equations require the moment of inertia of the platform, CAD tools were used to calculate the 
moment of inertia of the motor, the adapter plate and the bolt. One item that was not modeled in 
the simulation, or the calculations for determining control parameters, was the friction in the sys- 
tem. 
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In this particular device, there was a great deal of Coulomb friction in the base bearing. The 
components mounted to the base would not complete a single rotation before coming to a halt 
after an initial spin. This has the effect of adding instability to the system. In particular, what tends 
to happen is that the system will stay at some point for some period of time while the integrator 
error (the disturbance rejection) adds up. At some point, there is sufficient energy to overcome the 
static friction, which is less than the dynamic friction. Once moving, the system will tend to over- 
shoot the desired point and try to compensate, but the same sequence of events occurs. 

Figure 23 shows actual data from an experiment to control the physical device. Despite the 
friction problem, the results from this test are as expected. The system does oscillate about the 
control point, though it is quite noisy. 

An experiment was also performed to determine if the forces generated were noticeable by a 
human. To perform this experiment, three motors with momentum wheels were mounted onto the 
adapter block used in the previous experiments. 

The motors were spun up to a speed of 5000 RPM. Individuals were asked to handle the 
device and to make subjective evaluations of the torques felt as the device was moved about. In all 
cases, the subjects reported feeling appreciable forces that were deemed to be sufficient for carry- 
ing out meaningful tasks. A picture of the device is shown in Figure 24. 

The torques felt were generated because the control system had been commanded to main- 
tain the momentum wheels at a constant angular velocity. By moving the device about, the angular 
momentum vectors were changed, thus causing a torque. The control system compensated for 
these motions by adjusting the output to the motors. Since the motors were already spinning at 
high speed, the period of time for which a torque could be applied was far more limited than for 
the case where the motor is initially at rest. 

Having demonstrated that forces can be generated in any direction, the final task is to con- 
trol the motors in an appropriate manner so as to provide haptic feedback to the user. This task 
requires a sophisticated control algorithm for two reasons: first, the platform will be grossly dis- 
placed from its nominal operating orientation, and second, for any motion of the platform (for 
simplicity consider just rotations about the world coordinate axes with which the device is ini- 
tially oriented), some subset of the motors will produce torques (due to changes in the orientation 
of the angular momentum vectors) that are undesired. To counteract these undesired torques, 
some subset of the motors will need to be accelerated to produce counter torques. The control sys- 
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tern must model the full, non-linear dynamics of the system, have a high speed attitude sensor and 
possibly a control to smoothly generate the prescribed forces. A block diagram of the system is 

shown in Figure 25. 
Applications 

As discussed above, one family of applications for the devices described above utilizes 
inputs received from a virtual environment. For this type of application, the virtual environment 
models some set of objects, and hand controller or other force-reflection device produces forces 
that are representative of some activity within the virtual environment. Since it is not required that 
the forces produced correlate to any specific activity, the only restriction placed on the commands 
sent to the gyro-stabilized device is that the output forces be within the range of forces that the 
device can produce. An alternative family of applications for these devices produces forces in 
accordance with inputs received from a (possibly remote) physical device. For this type of appli- 
cation, the forces produced are typically a scaled representation of the actual forces produced at 
some point on the actual physical device. To provide the widest range of haptic input, the scaling 
is typically designed such that the maximum force that can be applied to the physical device is 
mapped into the maximum force that the haptic device can produce. 

To the first order, the devices described are marginally stable at best. To control these 
devices to produce desired torque outputs in the face of input disturbances, a two step controller is 
preferably utilized. The first step stabilizes the controller by doing a pole placement. The location 
of the poles can be determined using any applicable method although optimal control is preferred. 
The second step creates a robust controller by canceling out disturbance inputs. Robust control 
theory is applied for this task. 

With specific regard to platform stabilization, the desired input is typically a zero input, i.e., 
that the system should not change state. For these applications, sensor are employed to determine 
when the system changes state due to disturbances and the controller acts to return the system to 
the zero state. 

Unloading 

The human operator who controls the haptic device is, from the perspective of the momen- 
tum device, equivalent to group. Although any amount of angular momentum can be removed 
from the device when it is coupled to ground, since this is a haptic device, the strategy is to slowly 
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and continually remove angular momentum so as to have as minimal affect on the user as possi- 
ble. In particular, the momentum sphere has a maximum speed at which it can operate due to the 
materials and construction techniques employed. When the sphere approaches this maximum 
velocity, momentum must be unloaded from the sphere for it to continue to function. To do this 
requires the application of an external torque that will cause the angular momentum vector to be 
diminished. This can be accomplished in three ways: reaction jets, magnetic field torquers and/or 
spacecraft reorientation. The first two methods work by applying a torque to the spacecraft that 
diminished the angular momentum of the sphere. The third method works if the following two 
conditions are met: the disturbances to the spacecraft are primarily applied in the same direction 
and the spacecraft can continue to operate at different attitudes. If these conditions are met, the 
spacecraft can be reoriented such that the disturbance torque act to cancel the sphere's angular 
momentum. It may also be feasible to rigidly couple the platform to ground for a brief period of 
time. While coupled to ground, any amount of angulapnemeat^ can be removed from the stabi- 
lized platform. 

What is claimed is: 
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